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In 2004 NASA began investigation of a robotic servicing mission for the Hubble Space 
Telescope (HST). Such a mission would require estimates of the HST attitude and rates 
in order to achieve a capture by the proposed Hubble robotic vehicle (HRV). HRV was to 
be equipped with vision-based sensors, capable of estimating the relative attitude between 
HST and HRV. The inertial HST attitude is derived from the measured relative attitude 
find the HRV computed inertial attitude. However, the relative rate between HST and 
HRV cannot be measured directly. Therefore, the HST rate with respect to inertial space 
is not known. Two approaches are developed to estimate the HST rates. Both methods 
utilize the measured relative attitude and the HRV inertial attitude and rates. First, a non- 
linear estimator is developed. The nonlinear approach estimates the HST rate through an 
estimation of the inertial angular momentum. Second, a linearized approach is developed. 
The linearized approach is a pseudo-linear Kalman filter. Simulation test results for both 
methods are given. Even though the development began as an application for the HST 
robotic servicing mission, the methods presented are applicable to any rendezvous/ capture 
mission involving a non-cooperative target spacecraft. 


I. Introduction 

The Hubble Space Telescope (HST) was launched in 1990 and has undergone four servicing missions 
throughout its mission lifetime to replace instruments, sensors, solar arrays, power units, and cooling systems. 
Additional servicing will again be necessary to extend HST’s science life. The batteries are predicted to fail 
as early as 2009, and the pointing control system may be reduced to a two-gyro mode by as early as 2007. 
On March 12, 2004 former NASA Administrator Sean O’Keefe asked the HST program to investigate robotic 
servicing of the HST to extend the science life. In addition to replacing the batteries and gyros, the servicing 
mission would install two new instruments and would provide the ability to safely de-orbit HST. 

The original robotic servicing mission concept included two vehicles, a de-orbit module (DM) and an 
ejection module (EM) with the robotic arm for servicing. The DM docks with HST and provides batteries 
and gyros for the stacked HST-DM configuration. The DM also provides the reentry capability for the 
stacked configuration. The EM carries the robotic arm for servicing, as well as the replacement instruments. 
Following the servicing, the EM separates from the HST-DM stack and safely de-orbits. An alternative 
concept to the robotic servicing mission was to provide a de-orbit only capability for HST. A modified DM 
docks with HST and provides for a safe re-entry of HST. In this work we refer to the vehicle docking with 
HST as the Hubble Robotic Vehicle (HRV). 

In order for the HRV to dock with HST, the HRV must match the rotation rates of HST. If the batteries 
and gyros both fail, HST will be tumbling with unknown rates. The HRV will be equipped with sensors 
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capable of estimating the relative attitude between HST and HRV. The sensors utilize vision and feature 
recognition measurements to produce a relative quaternion. The HRV will also be equipped with star cameras 
and gyros which will provide the inertial orientation and body rates of the HRV. Combining the relative 
attitude and HRV inertial attitude provides a measurement of the HST attitude. However, the relative rates 
or HST body rates cannot be measured directly. 

We present and compare two approaches for estimating the HST body rates in the event that HST 
is tumbling and no a priori rate information is available. First a nonlinear estimator is developed. The 
nonlinear approach determines the HST rate through an estimation of the inertial angular momentum. The 
stability properties of the estimator are addressed first for perfect attitude measurements. Errors are then 
introduced into the HST attitude. ' The primary error source considered is the uncertainty in the relative 
attitude quaternion provided by the vision and feature recognition sensors. The results of the nonlinear 
approach are then compared to a pseudo- linear Kalman filter. 

Even though this work was originally developed for the HST/HRV scenario, it can easily be applied to 
other ‘non-cooperative’ rendezvous/capture scenarios. A ‘non-cooperative’ scenario is one in which the body 
rates of the target vehicle are not available, and the target vehicle does not carry any devices to improve the 
relative attitude estimation, such as reflectors or visible beacons. 

The paper is outlined as follows. The next section presents definitions and mathematical background. 
Section III presents the nonlinear estimation algorithm. Section IV discusses how measurement errors affect 
the nonlinear algorithm. Section V presents an overview of the pseudo-linear Kalman filter. Section VI 
includes results, followed by conclusions in the last section. 


II. Attitude and Angular Rate Definitions 


The attitude of a spacecraft can be represented by a quaternion, consisting of a rotation angle and unit 
rotation vector e, known as the Euler axis, and a rotation <f> about this axis so that 1 


Q = 


esin(f) 


£ 

cos(f) 


V _ 


( 1 ) 


where q is the quaternion, partitioned into a vector part, £, and a scalar part, 77. The Hubble Space 
Telescope (HST) attitude quaternion is designated as q v , which defines the rotation from inertial to HST 
body coordinates. The Hubble Robotic Vehicle (HRV) attitude quaternion is designated as q h . 

The rotation, or attitude, matrix can be computed from the quaternion components as 1 

R = R(q) = (t? 2 * - £ T e)I 3 + 2££ r - 2 t ? S( e) (2) 

where I 3 is a 3x3 identity matrix and S(e) is a matrix representation of the vector cross product operation. 




0 


£11 


0 £x 

E x 0 


Note also that R(q)e — e. 

A relative rotation between coordinate frames is computed as 2 



£ 


772^ — S(£2) — £ 2 

ei 

Q = 

. V . 

= <?i ® #2 = 

el r] 2 

m _ 


( 3 ) 


Using the definition given in equation 3, the relative attitude quaternion from HRV body coordinates to 
HST body coordinates is then 

= 9ft 1 ( 4 ) 

The angular velocity of the HST body coordinates with respect to inertial space, resolved in HST body 
coordinates, is designated as Similarly the angular velocity of the HRV in HRV body coordinates is 
designated as u;^. The angular velocity of HST relative to HRV, given in HST body coordinates , is given as 


u v r = u v - R r u h 

where R r is the relative attitude matrix which transforms into HST body coordinates. 


( 5 ) 
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III. HST Nonlinear Angular Velocity Estimator 


The following angular velocity estimator is intended for the scenario in which the HST batteries have died. 
No telemetry is available from HST. HRV is equipped with a quaternion star tracker, which gives q h , and 
some sensor system which produces the relative quaternion, q r . The approach does not yet account for any 
errors in the measured quaternions, the HST inertia matrix, or the computation of the external torques on 
HST. The HST angular velocity is estimated in the inertial coordinate system through the estimation of the 
inertial angular momentum. The HST angular velocity in body coordinates is computed by a transformation 
of the inertial angular velocity. In the following developments, the time argument is omitted to simplify the 
notation. 

The angular momentum in inertial coordinates is defined as 




where is the HST inertia matrix and u>i jV is the angular velocity, both in inertial coordinates. Note 
that I iyV = R y I v R V) where R v is the HST attitude matrix defining the transformation from inertial to HST 
body coordinates. I v is the HST inertia matrix in body coordinates, assumed to be constant. The kinematic 
equation for the quaternion is given as 

Qv = = ~^Q{ ( lv)Rv U *i'tV — ( 6 ) 


where 


Q(Qv) 


Tjylz + S(E V ) 


Ql(Qv) 

-£ T 

v J 


-£ T 


where, by inspection, Qi(q v ) = r)vh + S(e v ). The kinematic equation for the attitude matrix is 3 


(7) 


Rv = S{wv)R v ( 8 ) 

Note that the q v (and therefore the attitude matrix Ry) is supplied by the HRV measured inertial attitude 
and the measured relative attitude. Using equation 4 

Qv=Qr® Qh ( 9 ) 


Similarly 

Ry — R r Rh 

Euler’s equation describes the dynamics of a rigid spacecraft. Euler’s equation for HST is given in inertial 
coordinates as 4 

hi,v = Ti,v ( 10 ) 

T iiV is the external torque acting on HST, resolved in inertial coordinates. 

Define the estimated angular momentum as 


hi, v — t&i,v 


(ii) 


where is the estimated angular velocity in inertial coordinates. The estimated angular velocity in body 
coordinates is then 

£) v — Ry&i^y — Ryl^ v = I y Ryhi^y 

Using equation 1, define the predicted HST quaternion as 


Qv 


Tjv 


The attitude error is defined as the relative orientation between the predicted attitude q v and the attitude 
provided by the measured attitude, q v . The attitude error is 


Qv = 


Ey 

Vv 


= Q v ®Qv 1 


( 12 ) 
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Following the estimators proposed in Refs. 5, 6, and 4, a state estimator for the HST attitude and angular 
momentum is defined as 


hv = lQ(g„)fl(<j„(*)) T (A, 1 Ryh i ,v + ki v s\gn(fj v )} 


(13) 


hi , „ = T i<v + -R x v I v 1 i v sign(fj v ) 


(14) 


The term R(q v (t)) T in equation 13 transforms the angular velocity terms from the body frame to the 
predicted attitude frame. The gain k is chosen as a positive constant. Similarly, the learning rate, a, is also 
a positive constant. Essentially, q v is a prediction of the attitude at time t, propagated with the kinematic 
equation using the estimated angular momentum. 

The kinematic equation for the attitude error quaternion, q v , has the same form as the quaternion 
kinematic equation in equation 6. The angular velocity associated with the attitude error quaternion is the 
difference between the angular velocity of the body coordinates and the angular velocity of the estimator 
coordinates (resolved in body coordinates). 7 Therefore, with equation 6, the definition given in equation 
7, equation 13, and noting that R(q v (i))i v ~ e v (since i v points along the eigenaxis of the rotation), the 
kinematic equation for q v is given as 


q v 2 


(15) 


(16) 


Ql( 5 T u) (I~ l R v h i v - I~ l R v hi, v - ki v s\gn(rj v ) 

Let h i v = h i v — hi v . The derivative of h i v is 

h i%v = - < ^Rll~ l i v sign(jj„) 

Note that the equilibrium states for 15 and 16 are 

[ C Kv ] = [ 0 0 0 ±1 0 0 0 ] 

Proof of stability: Choose a Lyapunov function as (note that the time argument is omitted from the 
variables on the right side of the equation for clarity) 

1 h T h , 1 / fa - !) 2 + V” ^ 0 
,. 2 _ T _ . 

2a 2 1 (Vv + 1 ) +e v e v r)v < 0 


(17) 


V(t) is continuous. The derivative of V(t) is 

1 r T i , j (fiv - Ufc + fiv > o 

V[t) = -hi h i<v + < 

a [ (v v + 1 )fj 0 + i v io fjv < 0 

Noting that i T v t 0 + fj v rj 0 = 0 (including the left and right derivatives of f} v = 0), for all t, equation 17 is 

V(t) = 

This establishes that h iyV , £ v , and fj v are globally, uniformly bounded. Moreover, V(t) is a continuous, twice 
differentiable function with 

Vo(t) = ~elQi{q v )[Iv 1 Rvhi,v - k£ v siga(fj v )\ 

which is bounded. Barbalat’s lemma then shows that ||e„|| —» 0 as t —» oo. 8 

Since all signals in the estimator are bounded, the system 15 and 16 can be further analyzed, in the given 
format, as a linear time-varying system 9 x(t) = A(t)x(t) where 


x(t) — 


£v 

hi,v 


( 18 ) 
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\Qi{q v )I~ x Rv 

0 

where, by virtue of the above Lyapunov analysis, all terms in the matrix A(t) are known to be bounded 
for all t > to. Rewriting V(t) as V(t) = -x(t) T C T Cx(t) < 0, where C = ^ \J%h 0 j , Theorem 4.5 and 

the discussion on pp.626-628 in Ref. 9 shows that the equilibrium point ac(£) = 0 of this equivalent system 
is exponentially stable if the pair (A(t),C) is uniformly completely observable (UCO). Since observability 
properties are unchanged under output feedback, 9 (A(£), C) are UCO if the pair (A(t)— K{t)C, C) is uniformly 
observable for any piecewise, continuous and bounded matrix K(t ), Choose K(t) as 


A(t) = 


-|sign(^)Qi(qJ 


L 2 


f sign(rj v )R%I v 1 


K(t) = 


-\fisign(Vv)Qi{q v ) 

J^siga{fj v )Rl I~ l 


K (t) is piecewise continuous based on the following properties. Note from the above Lyapunov analysis that 
||e v || — > 0. Since ||qj| 2 = 1 = ||£ v || 2 + |^?v| 2 for any time, t, there exists a time, T > 0, such that ||^|| > 0 
for all t>T. Since fj v therefore cannot pass through zero for t > T, sign(7) v ) is constant for all t > T and, 
hence, K(t) is a piecewise continuous function of time. 

The state transition matrix for the pair {A(t) - K(t)C, C ) is 




1.3 Ur a) 
0 I 3 


(19) 


where E(r, t) = \ j * Q\ (q v (a))I v l R v (cr)da , with Qi(q v ) defined in equation 7. The observability Grammian 
is then 10 


/ t+T rt+T 

#(r,t) T C T C#(r,t)dr = j 


|I 3 | S(r,t) 

| £(r,t) r | E(r,f) T E(r,t) 


dr 


( 20 ) 


The system is UCO if there exists a T > 0 and positive constants ql\ < 00 , a 2 > 0 such that, for all 
t > t 0 ,ail > W(t f t + T) > a 2 l. Using Lemma 13.4 of ref. 9, this property is assured if Qiiq^I^Ry and 
■fciQxiqv)!^ 1 Rv) are bounded, and there exist positive constants T 2 , j3\, and a finite constant f3 2 such that, 
for all t > to, 

/ t+T2 

Rli; l Qx{q v ) T Qi{q v )K l RvdT > (hh (21) 

Qi{q v )I~ 1 R V is bounded, since all the signals in the estimator are bounded and the spacecraft inertia is 
bounded, hence the upper bound in 21 is satisfied. Substituting the equality Qi(q v ) T Qi(q v ) = I 3 — 
into equation 21 results in 


00 > fch > 


r 


i 3 - e v %)i- 1 R v dT > ai 3 > 0 


( 22 ) 


Recall that it has been shown that ||e„|| — * 0 asymptotically. Thus, for any <5 > 0, there exists a Ti(<5) > f 0 
such that ||£t,|| < 5 for all t > to + T\. Taking any S < 1, any T 2 > T), and any z in R 3 


/*t+T 2 

oo > (T 2 - Ti)ALxMI 2 >z T [J t (I - Svi T v )dr]z > (1 - S 2 )(T 2 - T^Jzf > 0 


(23) 


where \ max and A m i n are the maximum and minimum eigenvalues of I v 1 . Finally, 3 jQi(«J4 1 Ru is 
bounded, since all the terms in 15 are bounded. This demonstrates the required UCO property. The 
PE condition is satisfied, and therefore i v and h^ v approach zero exponentially fast, i.e [ju> v || — > ||u; v || 
exponentially fast. □ 


IV. Error Sources 

The analysis provided in Section III is for the ideal scenario with no errors in any of the measurements 
needed for the estimator. In reality, the measurements will be corrupted by errors. The primary error source 
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considered here is the error in the relative attitude measurement used to derive the HST attitude quaternion. 
The resulting error in the HST attitude quaternion leads also to an error in the computation of the gravity 
gradient torque, the dominant external torque acting on HST. The following analysis considers how the HST 
attitude error affects the estimator stability and convergence properties. 

The measured HST quaternion, q ViTn , is written as 

Qv,m ^Qerr ® Qv (2d) 


where Sq err is the error between the true HST quaternion, q v , and q v m . Recall that q v results from the 
product of the HRV relative attitude quaternion, q r , and the HRV inertial attitude quaternion, q h , shown 
in equation 9. The error is written as 


v ^Qerr 


&err 

Verr 


From 24, the rotation matrices are given as 


Rv,m = R{q v , m ) = R{Sq err )R(q v ) = R{5q err )R v (25) 

Multiplying both sides of equation 24 by q v gives 

Qv,m = ^erv ® 9v ( 26 ) 

Similarly, 

R(q v ,m) = R(Sq e rr)R(Qv) 

Since the true quaternion is unknown, equations 13 and 14 cannot be implemented 
in place of g v , resulting in 

q v — 1 Rv,mhi,v + ^£u,mSign(f/ V5m )] (28) 


(27) 

. Instead, q v m is used 


h'ijV — 4“ (29) 

Ti, v is the estimated external torque. Equations 25 and 27 are substituted into 28 

tiv = ^Qi^RiqvViRiSqerrflv'RiSqerJRvhi'V + kR{Sq err ) T i v<m Slgn(fl v<m )} 

Rearranging the terms results in 

tiv = \Q(q v) R (q v ) T [ I v lR vKv + ki v s\gn{fj v ) + &ih i<v + A 2 ] (30) 


where 

A x = [R(5q err ) T I „ 1 R(6q err ) - I^R, 

A 2 = k[R(6q eTr ) T i v , m sign(rj v , m ) - i v sign(fj v )} 

Ai and A 2 are both bounded. Ai results from the discrepancy in the HST inertia in the inertial frame due 
to the attitude error. A 2 results directly from the attitude error. 

Next, equation 29 is analyzed. Recall that the true angular momentum is driven by the external torques 
acting on HST, shown in equation 10. The dominant external torque acting on HST is gravity gradient 
torque. The gravity gradient torque in inertial coordinates is given as 11 


T itV = ^S(rlJRll v R v rl v 

T*? 


(31) 


where [i is the earth’s gravitational parameter, r^ v is the magnitude of the HST inertial position vector, and 
rf v is the inertial position unit vector. The estimated torque in equation 29 is computed as 


v 


( 32 ) 


6 of 14 


American Institute of Aeronautics and Astronautics 



Substituting equation 25 into 32, T^ v is written as 


fi,„ = ^S(rl v )R T v I v R v rl v + A 3 = T ilV + A 3 


where 

A 3 = 

r- 

l,U 

Substituting 33 and 25 into 29 results in 

= 7i,„ + A 3 + |-/?2’/“ 1 e 1 ,sign(»fo) + A 4 


where 

A 4 = -Rl[R(Sq err ) T I~ 1 e„, m sign(77„, m ) - J'^signfo)] 
Combining equations 30 and 34 with 6 and 10, we get 




%Q(q v (t))(I v 1 Rvh i<v - ki v sign{rj v )) + A{h^ v + A' 2 

hi v 


-ff^Z-^sign^) + A' 3 + A 4 


where A, = -\Q{q v {t)) A lt A' 2 = -\Q{q v (t))A 2 , A 3 = -A 3 , and A 4 = -A 4 . 
Equation 35 has the form 

x(t) = f{t,x(t)) +d(x,t) 

where f(x 7 t) has been shown to be exponentially stable and 


&ihi,v +. A 2 


A3 + A4 


= di(t) + cfe(f) 


(33) 


(34) 


(35) 


where 


d\(t) = 


Ai^i,v 

0 


and d 2 (t) contains the remaining terms, which are all bounded. Since d, 2 (t) is bounded, the exponentially 
stable system is robust to this perturbation. The concern, however, is with di(t) which contains part of the 
state and hence cannot be assumed bounded a priori. If exponential stability is preserved with di(f), then 
the system will be robust to the combined disturbance d(t). 

The nominal system is exponentially stable. Therefore, according to the Converse Lyapunov Theorem, 
a Lyapunov function and positive constants ci, c 2 , C3, and C4 exist for the nominal^system and satisfy the 
following 9 

ci||*(t)|| < V p {t) < c 2 \\x{t)\\ 

V P (t) < -c 3 ||x(t)|| 2 
9V v (t) 


dx 


< c 4 [|aj(t)|| 


Using V p (t) as the Lyapunov function candidate for the system perturbed by di(t), the derivative of V p (t) 
satisfies 

l|2 , „#], 


which becomes 


Note that we can write 


v P (t) < -c 3 \ix(t)r + 

Vp{t) < -c 3 ||z(t)|| 2 


„ Sx -IIIMxWII 

C 4 ||x(t)||||d 1 (t)|| 


(36) 


di(t) = 


A l^lyV 


A \{hi^ v >v ) 


Ai hi iV T 

0 


0 


0 
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A'i h i v can be moved into d, 2 (t) since the angular momentum of HST will be bounded. Equation 36 is then 


V p (t)<-C3||x(t)|| 2 + C 4 ||x(i)|||| 


-A[hi, v 

0 


V P (f)<-C3||x(t)|| 2 +c 4 (5||x(t)|| 2 (37) 

where || A^H < S . If 5 is sufficiently small, exponential stability is preserved, and the system is robust to the 
combined perturbation d(t) = dx(t) -+■ d 2 (t) 

Adding d 2 (t ) back into the Lyapunov analysis, equation 37 becomes 

K P (0<-C3lkWI| 2 + C 4<5||x(<)|| 2 +c 4 ||x(0lll|d 2 (i)|| (38) 

The bound on || A^ || , which establishes the size of tf, and the bound on || c ?2 (^) II are defined next. From 
equation 2, R(Sq err ) can be written as 


■R'i^Qerr) — ilerr ^err £ err)^3 "t" 2s err £ err 2T} err S (£ err ) 
= ^3 Y {Werri ^err) 


^3 2£ err £ err + 2£ err £ err 27] err S{£ err ) 

(39) 


and 

\\Y { r 1err^err)\\ ~ 2 || &err || 

Also, note that ||Q(g„(t))|| = 1, ||.R„|| = ||i^(q lI )|| = 1, ||£„|| < 1, ||£u,m|| < 1, ||/«|| < A max , and H/" 1 1| < 
yd — • The [I A. [I is then bounded as 

''min *• 11 


K||<i||A 1 ||<^i(l + || £e rr||)<«5 

^ Amin 


The ||d 2 (t)|| 1S bounded as 

IldaWII < IIA2II + IIA'all + ||Ai|| + ||Ai||||fc 1 , 1 ,|| ma , 


(40) 


with 

l|A' 2 || < fclkerrll 

iia^ii < 12/X - A m ; 3 ?l|g - rrll (i+ii^ r |i) 

T- 

i,v 

II A 4 H < Y~ll £ err|| 

The angular momentum of HST is bounded as 

II ~ || ^6, v || ^moi ||^ , 6,v,macc || 

Extensive simulations of HST predict the maximum angular velocity as approximately 0.004 rad/sec. 12 
Therefore, 

II Ai HIM™, < °- 0Q8A , mQxl|£errJ (1 + Ikerrll) 

Amin 

Applying Young’s inequality to equation 38, and combining terms gives 

V p (t) < -(ic 3 -C4<5)||x(t)|| 2 + ^||d 2 (t)|( 2 (41) 

Substituting all the bounds into equation 40, equation 41 is written as 

W<-(^ 3 -c 4 <5)||x(f)|| 2 + J-|| £err || 2 (a + 6|| £err |() 2 (42) 


8 of 14 


American Institute of Aeronautics and Astronautics 



where a = k + + 12 ^ o x + 00 ° 8 * - mai and b = * - 2 # *- ai + Recal i that ||£ e rrii = sin \<p err . 

Amin T'f Amtn “* jV A min " " * 

Assuming the <j> err is small, ||e crr || ~ \<t>err ■ Equation 42 is then 


Vp(t) < -(^C 3 - c 4 5)||l(t)|| 2 + ^<t>lrr{a + ~b<j> err ) 2 


Neglecting powers of 4> err greater than 2 gives 


2 , aM ,2 


Vp(t) < -(-C 3 - C 4 (S)||x(<)|| 2 + ^^err 
Computing the time average of equation 44, and taking the limit as T — > oo, is 


(43) 


(44) 


limsup- 

T— +oo i 



2 dr < limsup 

T— ►oo 


a 2 c 2 


8c 3 (c 3 - c 4 £) 



If the error process is ergodic, the ensemble average is equivalent to the time average. The RMS bound is 
given as 

II hi,v\\RMS < ||x(t)||*A#S < ccr (45) 

where cr is the standard deviation of the error process, and all the constants are combined together as 

c = ac * 

803(03 — C4<5) ' 

Equation 45 serves to demonstrate that the angular momentum estimator is bounded, and converges 
to a ball sized by the bound given in 45 (given that the attitude is corrupted by errors meeting the above 
statistical assumptions) . Equation 45 sizes the errors only to within the original unknown constants of the 
converse Lyapunov analysis. The characteristics of the estimator error will be addressed through numerical 
simulations. 

The instability resulting from di(t) can be removed through the introduction of a ‘leakage’ term in 
equation 29. 

hi, v — f t> + -Rv im I~ l i Vim sign(q Vim ) - cr{hi tV )h iiV (46) 

if ||^i,v|| > ||hi )t ;||max > l|^i,v|| 

otherwise 

where the scalar cr 0 > 0 and ||/ii, v ||max is the upper bound on the angular momentum established above. 
The additional term in 46 introduces an additional term into equation 38 


where 



~T 


crh^ v hi v — u (/^i,v v ) chj^ v hi^ v 


Applying Young’s inequality results in 

A« s -^ii^ll 2 + |*iimi 2 

Since hi fV is assumed to be bounded, the second term acts as another bounded disturbance. The first term, 
however, acts to stabilize the possible high noise instability identified above. In particular, if <j 0 > 2 C 4 S 
then the system remains stable. The process to establish the bounds outlined above remains the same, with 
c 3 — + \(j 0 replacing c 3 — c 4 6. 

Although it looks like this technique adds an additional disturbance, possibly stabilizing the system but 
adding an extra error, in fact this is not the case. Expanding the added term instead as 

~ hj ? t>) hi,v = 0"hx l irh't ) u ^ 1 1 ! k 


Or 


<7hi iV hi iV < ll^ijwll 


Recall from above the a > 0 only if \\hi )V \\ > ||h i)V ||. Thus the added term is always negative; essentially the 
extra constraint in the adaptation law can only help convergence. 
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V. HST Pseudo-Linear Angular Velocity Estimator 


The pseudo-linear Kalman filter is based on the model presented in reference 13. A brief overview of the 
filter models is given first, followed by a summary of the actual algorithm equations. 

The state of the filter is „ 


<lv 


where q v is the HST inertial attitude and u> v is the HST angular velocity in HST body coordinates. The 
quaternion is propagated according to equation 6 as 


Qv = ^Q{Qv) u v 


(47) 


The angular velocity is propagated using Euler’s equation as 




(48) 


where % & jV is the gravity gradient torque from equation 32, transformed to body coordinates as 

Tb,v = S(rl v )I v R v rl v 

rr 1 

1 i,v 

where = R v r^ v . Equation 49 can be written in a pseudo-linear form as 

= Z^S(r^ v )I v M(r™ v >q v )q v = Pggq v 

T i,v 


(49) 


(50) 


where M(r^ v , q v ) is defined in reference 14. Equation 50 is substituted into 48, and equations 47 and 48 are 
then augmented as 

X = F(X)X 4- w(t) (51) 

where in(£), a zero-mean white noise process, is added to account for the lack of knowledge in the terms 
given in equations 47 through 50. F(X) is defined as 


F(X) = 


o ^Q(Qv) 

l;'F gg 


(52) 


The measurement used in the filter is q v rn given in equation 24. The measurement model for a given 
time t k is simply 

9v,m,fc = [ I 4 0 ]x k =HX k +v k 

where I 4 is a 4x4 identity matrix and v k is a zero-mean white measurement noise. 

The filter algorithm is implemented discretely as follows: 

Propagation : 

= W fc (+) 

= e F(X fc (+))At 

At = t k +i - t k 

p k+ i(-)=$ fc p fc (+)$r+Q 

where P is the filter covariance, Q is the process noise covariance matrix, and (— ) and (-f) indicate a priori 
and a posteriori values, respectively. 

Update : 


X k (+) = X fc(-) + K k (q v>m , k - q fc (-)) 

K k = HP k (-)(HP k (-)H T + R )~ l 
P k (+) = (I - K k H)Pk (-)( I - K k Hf + K k RKl 

where K k is the filter gain matrix at time, t k , and R is the measurement noise covariance matrix. 
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VI. Simulation Results 


The algorithms outlined in sections III through V are tested with a simulation. The simulation includes 
two orbits of data, based on an actual HST ephemeris. The HST inertia is 12 


Iv = 


36046 -706 1491 

-706 86868 449 

1491 449 93848 


kg • m 2 


Both algorithms are initially tested without any errors. In both cases, the initial attitude quaternions 
are identity, q v = q v = [0,0, 0,1]. The initial HST angular velocity estimate is zero, = [0,0,0], and the 
true initial angular velocity is cj v = [-0.04,-0.01,0.14] deg/sec. 

Figures 1 and 2 are examples of the resulting angular velocity error from the nonlinear estimator and the 
pseudo- linear filter, respectively. The pseudo-linear algorithm converges very quickly, but the error oscillates. 
The nonlinear estimator has a longer convergence time, however the errors after convergence are very small. 
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Figure 1. Angular Velocity Errors: Nonlinear, No Attitude Measurement Errors 
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Figure 2. Angular Velocity Errors: Pseudo- Linear, No Attitude Measurement Errors 

Next, the measured attitude is chosen randomly with a 15 degree uncertainty. Figures 3 and 4 are samples 
of the angular velocity error for the nonlinear estimator and the pseudo-linear filter, respectively, using the 
same erroneous measured attitudes. As with the clean example above, the pseudo-linear filter converges 
faster, but is noisier than the nonlinear estimator in steady state. 
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Figure 3. Sample Angular Velocity Error: Nonlinear, Random 15 Degree Measured Attitude Error 


Table 1 lists the average of the final RMS angular velocity error for each of the 100 test cases, for both 
the nonlinear estimator and the pseudo-linear Kalman filter. The average errors are smaller for the nonlinear 
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Figure 4. Sample Angular Velocity Error: Pseudo-linear, Random 15 Degree Measured Attitude Error 


estimator on all three axes. 


Table 1. Average Final RMS Angular Velocity Errors 



Nonlinear (deg/sec) 

Pseudo- Linear (deg/sec) 

&x,RMS 

0.00164 

0.00516 

Vy^RMS 

0.00164 

0.00558 

&z,RMS 

0.00127 

0.00555 


Finally, figure 5 shows the RMS angular momentum at the end of two orbits for each of the 100 test 
cases. These results could be utilized in analyzing the numerical bound expressed in equation 45. 

VII. Conclusions 

A nonlinear algorithm is developed to estimate the rotation rates for a ’non-cooperative 5 target vehi- 
cle. The nonlinear algorithm determines the rotation rate through an estimation of the inertial angular 
momentum. The algorithm, designed for the Hubble Robotic Servicing mission, applies in particular to the 
scenario in which the batteries have died and HST is tumbling. The HRV design includes vision and feature 
recognition sensors capable of producing a relative attitude quaternion. Combining the relative attitude with 
the HRV inertial attitude produces the measured HST attitude for the estimation algorithm. The nonlinear 
algorithm is compared to a pseudo-linear Kalman filter. 

The two rate estimation approaches are compared using two orbits of HST data. Initially, the algorithms 
are compared with perfect measured attitudes. Both algorithms estimate the HST rotation rate. The 
pseudo- linear algorithm converges quickly, but oscillates slightly in steady state. The nonlinear approach 
is slower to converge; the steady state errors, however, do not oscillate and are very nearly zero. The two 
approaches are then compared for 100 different cases, with different random measured attitudes in each case. 
Again, both approaches estimate the rotation rate quite well. However, the nonlinear approach produces 
consistently smaller final rotation rate errors. 
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3.2 



Figure 5. Final Angular Momentum Error RMS 


Future work will focus on improving the accuracy of the relative attitude quaternion computed from 
the vision and feature recognition sensors. Additional error sources, such as uncertainties in the spacecraft 
inertia, should be addressed, as well as a more rigorous study of the nonlinear estimator gains. Also, the 
algorithms will be coupled with a control scheme to study the closed loop behavior during a rendezvous or 
docking scenario. 
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